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LONG-TERM  GOALS 

The  long-term  goal  is  to  enable  the  creation  of  a  multiple- AUV  testbed  in  which  control  strategies  for 
network  coordination  can  be  studied  in  three-dimensional  space. 

OBJECTIVES 

The  objective  of  this  project  is  to  provide  a  sensing  and  navigation  system  that  will  support  the 
coordination  of  multiple  underwater  vehicles  in  a  freshwater,  laboratory  test  tank.  At  Princeton 
University,  an  investigation  into  coordinating  control  strategies  is  already  underway  and  an  indoor 
multiple  AUV  experimental  testbed  is  under  development.  The  indoor,  freshwater  experiment  allows 
for  comprehensive  testing  of  control  architectures,  low-level  control  laws  and  dynamics  of  a  fleet  of 
AUVs  in  an  environment  that  can  be  controlled  and  manipulated  as  desired.  A  key  challenge  to 
operating  a  group  of  AUVs  in  an  indoor  tank  or  pool  is  the  development  of  a  sensing  and  navigation 
system  that  provides  to  each  vehicle  not  only  its  own  position  and  attitude  but  also  the  relative  position 
and  attitude  of  at  least  its  nearest  neighbors.  The  aim  of  the  sensing  and  navigation  system  is  to 
provide  for  this  critical  capability  for  a  group  of  AUVs. 

APPROACH 

In  order  to  create  a  testbed  for  experimenting  with  network  control  laws,  it  is  necessary  that  each  AUV 
not  only  navigates  individually  but  also  senses  the  relative  position  and  attitude  of  its  nearest 
neighbors.  The  sensing  and  navigation  instrumentation  is  intended  to  address  these  needs  using 
acoustic  and  optical  solutions.  To  sense  the  absolute  position  of  each  vehicle  we  consider  using 
acoustics  at  appropriate  frequencies  to  minimize  the  reverberations  from  the  walls.  Three  baseline 
stations  are  placed  at  the  circumference  inside  the  tank.  Those  three  base  stations  will  send  out 
synchronized  acoustic  pings.  Each  AUV  in  the  network  will  receive  these  acoustic  signals  as  well  as 
an  RF-synchronization  pulse.  This  allows  for  the  on-board  computation  of  each  vehicle's  global 
position,  based  on  the  known  synchronization  time  and  the  known  location  of  the  base  stations.  The 
approach  has  the  advantage  to  allow  for  additional  vehicles  in  the  tank  without  requiring  additional 
acoustic  energy  in  the  tank  that  would  lead  to  a  deterioration  of  the  position  accuracy  (scalability  and 
multi-path  reduction).  Heading  will  be  measured  using  a  fiber  optic  gyro  because  of  interference 
problems  of  the  earth  magnetic  field  with  the  steel  tank.  Relative  position  and  attitude  measurements 
will  be  determined  two  ways,  and  the  two  will  be  fused  to  get  the  best  kind  of  information  for  feedback 
control.  The  first  method  will  be  to  use  radio-frequency  (RE)  communication  via  a  central  computer 
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such  that  each  vehicle  ean  be  provided  with  the  absolute  positions  of  its  nearest  neighbors.  Eaeh 
vehicle  ean  then  ealeulate  the  relative  positions  of  its  neighbors  by  subtracting  its  own  position  from  its 
neighbors.  The  seeond  method  will  use  opties  to  determine  direetly  the  relative  position  and  attitude  of 
a  vehicle's  nearest  neighbors.  This  ineludes  the  use  of  position  sensitive  deviees  (PSDs),  commereially 
available  blob  traekers  and  stereo  computer  vision.  The  PSDs  also  have  the  potential  to  be  used  for 
basic  communication  directly  between  vehieles  (e.g.,  by  means  of  sensing  and  then  deeoding  light 
pulses).  Besides  being  used  as  a  navigational  tool,  the  blob-traeker  (CMU-CAM)  and  the  stereovision 
system  will  also  be  used  for  sensing  objeets  in  the  environment,  for  example,  in  the  eontext  of  a  seareh 
task  or  an  obstacle  avoidanee  task.  In  the  ease  of  the  blob-tracker  we  are  limited  to  track  simple 
geometries  (Blobs)  with  the  advantage  of  having  a  Commercial-Off-The-Shelf  (COTS)  product  with  a 
high  update-rate  for  position  information  and  an  adaptable  data  interfaee.  The  on-board  vehiele 
controller  has  to  be  designed  for  a  reasonable  bandwidth  (-'10  Hz)  and  ease  of  use  for  a  large  user 
eommunity.  The  ehoice  was  made  to  implement  the  Matlab/Simulink  environment  for  its  user 
interfaee  and  widespread  use  in  the  controls  community  and  Mathworks’  new  XPC  target  toolbox  that 
allows  for  real-time  eomputations  on  standard  computer  hardware  sueh  as  a  PC  104  eomputer. 

Ralf  Baehmayer  (Researeh  Staff)  and  Naomi  Leonard  (PI)  lead  this  effort.  Robert  Sorenson 
(Teehnical  Staff)  and  Edward  Eiorelli  (Graduate  student)  and  Derek  Paley  (Graduate  Student)  as  well 
as  a  number  of  undergraduate  students  support  this  effort  on  a  part-time  basis. 

WORK  COMPLETED 

As  part  of  the  larger  testbed  development,  we  have  designed  and  completed  most  of  the  eonstruction  of 
four  “Princeton  Grouper”  vehieles.  The  design  of  the  seeond  and  third  generation  was  slightly  altered 
based  on  the  experienee  of  the  former  generations.  This  development  has  signifieantly  improved  the 
manageability  of  the  platforms.  Only  minor  changes  to  the  propulsors  were  neeessary.  The  eontroller, 
motor  and  propeller  charaeteristies  for  the  initial  set  of  thrusters  were  suecessfully  matehed,  and  this 
allowed  for  a  quick  reproduction.  We  have  developed  a  smart  interfaee  for  our  sensors  and  actuators 
using  a  common  communication  bus  and  a  standardized  protoeol.  In  addition  to  the  motor  eontroller, 
the  interface  has  been  implemented  on  the  depth  sensor,  temperature  sensor,  fiber  optic  gyro, 
inclinometer  and  on  a  battery  monitor.  The  smart  motor  eontroller  boards  were  developed  into  a 
robust  subsystem  that  allows  for  easy  reconfiguration  of  the  overall  propulsion  system  with 
interehangeable  components.  More  then  20  computer  boards  were  produced  out-of-house  and 
integrated  into  the  grouper  system. 

Eurther,  towards  the  sensing  and  navigation  system,  we  have  performed  testing  of  an  RE-modem  for 
underwater  communieation  in  the  test  tank.  A  highly  aeeurate  temperature  sensor  with  a  smart 
interfaee  was  developed  as  part  of  an  undergraduate  student  projeet.  We  have  aequired  several  fiber 
optie  gyros  as  a  heading  referenee  for  the  individual  vehicles.  The  interface  and  a  data-buffer  board 
were  designed  and  tested  and  await  implementation.  We  have  made  significant  progress  on  the 
development  of  a  vision-based  heading  module  using  position  sensitive  devices  (PSDs).  Two  student 
projeets  eontributed  to  this  effort.  The  PSD  work  is  in  progress  as  we  aim  to  use  the  technology  for 
relative  position/heading  measurements  of  neighboring  vehicles.  Another  student  projeet  implemented 
the  first  stage  of  the  Blob  trackers  on  a  moek-up  vehiele  in  stereo  mode  and  performed  a  system 
performance  study  with  a  pan  and  tilt  system  using  COTS  servos.  A  global  (tank-fixed)  vision  system 
with  an  appropriate  frame  grabber  was  installed  in  the  tank  allowing  for  real-time  vehicle  monitoring 
and  reeording  as  well  as  providing  the  framework  for  future  eomputer  vision  experiments.  The 
aeoustic  navigation  system  has  been  installed  in  the  tank  and  we  are  eurrently  working  on  the  ping 
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synchronization.  An  acoustic  Doppler  velocity  meter  was  installed  and  tested  on  a  grouper  vehicle  and 
is  expected  to  considerably  improve  the  positioning  system.  A  seeond  Doppler  was  tested  and  awaits 
integration  in  a  new  grouper  vehicle.  In  an  effort  to  facilitate  controller  development  and 
implementation  we  have  just  concluded  the  development  of  a  driver  for  the  fiber  optic  gyros  to  be 
utilized  on  a  single  board  eomputer  (PC  104)  with  Matlab  XPC-target.  This  allows  us  to  design  and 
implement  controllers  into  the  vehicle's  main  computer  using  standard  sensor  and,  in  the  near  future, 
actuator  blocks  without  cumbersome  coding.  This  approach  benefits  heavily  from  the  communieation 
arehitecture  and  the  smart  interfaces  of  sensors  and  actuators  implemented  on  the  vehicles.  For  real¬ 
time  data  visualization  we  designed  a  virtual  environment  for  the  Grouper  vehiele  that  allows  the  user 
to  replay  the  colleeted  attitude  and  position  information  through  a  web-based  interface. 

RESULTS 

Early  closed-loop  control  of  the  grouper  prototype  showed  the  feasibility  of  hardware-in-the-loop 
development  by  using  standard  software  tools  to  design  and  tune  the  vehiele  controllers  on-line.  We 
established  that  a  controller  update  rate  of  lOHz  is  suffieient  for  our  system.  Early  progress  on  sensing 
and  navigation  using  PSDs  shows  promise  for  their  use  in  heading  and  position  measurement  both  with 
respect  to  a  fixed  reference  as  well  as  a  moving  reference  (neighboring  vehiele).  As  expected,  the 
aeoustic  system's  performance  is  highly  dependent  on  the  echo  level  present  in  the  tank.  Sound- 
absorbent  eoating  of  the  wall  behind  a  base  stations  proved  to  be  one  key  factor  towards  obtaining 
accurate  measurements.  The  distributed  communication  architecture  and  the  smart  interfaces  of 
sensors  and  actuators  implemented  on  the  vehieles  provide  an  easily  reconfigured  and  adaptable 
testbed.  The  new  real-time  software  tools  showed  their  potential  in  making  the  overall  control  system 
user  friendly.  Initial  results  on  the  virtual  reality  data  replay  functionality  are  promising  and  will  be 
pursued  for  a  real-time  display  using  the  RE-communieations.  The  overall  system  showed  its  potential 
in  edueating  and  inspiring  students  and  researehers  in  various  related  science  and  engineering  projeets. 
Multiple  independent  student  projeet  and  senior  theses  were  performed  in  the  framework  of  this 
development. 

IMPACT/APPLICATIONS 

The  sensing  and  navigation  system  will  make  it  possible  to  ereate  a  multiple- AUV  testbed  in  whieh 
control  strategies  for  group  eoordination  can  be  studied  in  three-dimensional  spaee.  Existing  testbeds 
for  group  eoordination  are  typically  confined  to  two  dimensions;  for  example,  roboties  researchers  use 
mobile  robots  on  the  ground  to  investigate  coordinating  controllers.  Eurthermore,  fluid  dynamic 
effects  between  vehieles  can  be  examined  in  the  multiple- AUV  testbed.  While  eoordinating  strategies 
for  multiple  vehicles  should  be  tested  at  sea,  a  laboratory  testbed  makes  it  possible  to  develop  and  test 
these  strategies  beforehand  (and  afterwards)  in  a  readily  aeeessible  environment  that  can  be  controlled 
and  manipulated  as  desired.  That  is,  the  multiple -AUV  testbed  can  be  used  as  a  proving  ground  to 
prepare  for  the  at-sea  trials.  In  our  other  underwater  vehicle  researeh  projects,  e.g.,  the  underwater 
gliding  project,  we  have  found  such  laboratory  testbeds  invaluable  both  for  researeh  and  education. 

Research  in  coordination  of  a  fleet  of  AUVs  has  the  potential  for  significant  impact  since  it  is  expected 
to  be  useful  for  effeetive  and  efficient  adaptive  oeean  sampling  that  would  not  otherwise  be  possible 
with  individual  vehicles. 
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RELATED  PROJECTS 


This  DURIP  project  is  closely  related  to  my  ONR  projects  on  Underwater  Glider  Dynamics  and 
Control  and  Underwater  Glider  Networks  for  Adaptive  Ocean  Sampling.  The  advantages  associated 
with  underwater  gliders  are  expected  to  be  greatest  when  multiple  gliders  are  operated  cooperatively  in 
a  network.  These  two  ONR  projects  are  part  of  the  Autonomous  Ocean  Sampling  Network  (AOSN-II) 
project  and  the  Monterey  Bay  Field  Experiment  2003.  A  central  part  of  this  project  and  upcoming 
experiment  is  to  provide  adaptive  sampling  using  a  group  of  underwater  gliders  for  the  purpose  of 
ocean  prediction.  See  http://www.princeton.edu/~dcsFaosn 

I  participate  in  an  NSF/KDI  funded  project  joint  with  A.S.  Morse  (Yale),  P.  Belhumeur  (Yale),  R. 
Brocket!  (Harvard),  D.  Grunbaum  (U.  Washington)  and  J.  Parrish  (U.  Washington)  on  coordination  of 
natural  and  man-made  groups.  We  are  studying  schooling  of  fish  and  “schooling”  of  autonomous 
underwater  vehicles.  Development  of  the  Princeton  multi-vehicle  testbed  was  initiated  as  part  of  this 
project. 

I  also  have  an  AFOSR  funded  project  on  Coordinated  Control  of  Groups  of  Vehicles.  This  is  a  joint 
project  with  V.  Kumar  and  J.  Ostrowski  at  the  University  of  Pennsylvania.  A  focus  of  the  project  is 
understanding  cooperation  in  the  context  of  coordinated  control  of  distributed,  autonomous  agents,  and 
the  collection  and  fusion  of  the  sensor  information  that  they  retrieve.  The  testbed  is  ideal  for  testing  in 
this  context. 
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